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SUMMARY 

This paper extends to flexible multibody systems the recent [1-6] results of the author 
on the use of spatially recursive filtering and smoothing techniques to multibody dynamics. 

The configuration analyzed is that of a mechanical system of flexible bodies joined together 
by articulated joints. It is established that the composite flexible multibody mass matrix 
M can be factored as M = (7 + K)D(I + K *) in which K is a lower-triangular factor, V 
is a diagonal operator, and K* is an upper-triangular factor. The operators (7 + K) an 
D can be constructed by means of a spatially recursive Kalman filter that begins at the 
tip of the system and proceeds inwardly toward the base. Similarly, the upper triangu ar 
factor [I + K*) is constructed by means of a corresponding outward smoothing recursion. 

The inverse (7 — £) = (7 + K) -1 of the causal factor (7 + K) is also a lower-triangular 
matrix. This inverse (7 - £) and its upper-triangular transpose (7 - £*) can also be 
computed by means of filtering and smoothing operations respectively. This means that 
the inverse ^ of the mass matrix can be factored as M (7 ) v 

The foregoing factorization results are used to develop spatially recursive algorithms for 
multibody system inverse and forward dynamics. The algorithms are what is referred to 
as Order N in the sense that the total number of arithmetic operations increases only 
linearly with the number of bodies in the system. 

1. INTRODUCTION 

The problem of flexible multibody system forward dynamics consists of finding the 
joint angle accelerations and the flexible body accelerations, given the applied moments 
at the joints and the forces due to the elastic deformation of the flexible bodies in the 
system. The closely related problem of inverse dynamics is to find the set of joint moments 
that must be applied in order to achieve a prescribed set of system accelerations. These 
problems are particularly important in the simulation and control design for systems which 
are not readily tested in a ground laboratory. Examples of such systems include future 
space manipulators (referred to as space cranes) to be used for handling and retrieval of 
free-flying satellites and space platform modules. Flexible dynamics problems are also 
encountered in multiarm manipulation of such flexible task objects as thermal blankets, 
hoses, extensible cables, and spring-loaded mechanisms. 

2. PROBLEM STATEMENT 

Consider a mechanical system consisting of N flexible bodies numbered 1, • • • , N con- 
nected together by N joints numbered l,-.-,iV to form a branch-free kinematic chain. 
The bodies and joints are numbered in an increasing order that goes from the tip of the 
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system toward the base. Joint k in the sequence connects bodies k and k + 1. Joint 0 can 
be selected at any arbitrary point in body 1. 

A typical flexible body k is characterized by a finite-element model consisting of a 
finite number of nodes defined at the spatial locations i. These locations are expressed in 
a coordinate system attached to the body. The set of all finite-element nodes for body k 
is denoted by fi(&), and the total number of nodes is AT*. 

The finite-element model for body k also involves a mass matrix m k and a stiffness 
matrix s k , which are assumed to be obtained from a stand-alone structural dynamics 
analysis of this body. It is assumed that the flexible body mass and stiffness matrices 
are time-independent quantities computed in advance. Alternatively, the flexible body 
mass and stiffness properties are characterized by pre-computed vibrational modes and 
the corresponding modal frequencies. 

A 6-dimensional displacement at node i of body k is denoted by = [a(t),x(t)l in 
which a(t) is a 3-dimensional rotation and x(t) is a 3-dimensional translation. These nodal 
displacements are expressed in a local coordinate frame attached to body k. The corre- 
sponding velocities and accelerations are respectively ti fc (*) and u k (i) and are also expressed 
m the same local coordinate frame. The displacement field u k = [u*(l) ... u k (N k ) ] pro 
duces an elastic force field f k = [/*(l),- ,/*(JV*)] which can be computed a!s /* = -s k u k 
m terms of the stiffness matrix s k . 

The joints labeled are single-degree-of-freedom joints, which allow rotation along the 
joint axis only. For these joints, h(k) is a unit vector along the axis of rotation; F(k) is 
the active moment applied about the axis of jourt*; 6(k) is the corresponding joint angle 
which is positive in the right-hand-sense about h{k). The relative angular velocity and 
acceleration at joint k are denoted by 0{k) and 6{k). 

The objective in forward dynamics is to outline a recursive method for computation 
o the jomt-angle accelerations 9(k) and the flexible-body nodal accelerations u k (i) for i in 
fl(fc), given the applied moments F(k) and the elastic forces /*. The objective in inverse 
dynamics is to compute the set of forces and moments that must be applied in order to 
achieve a set of prescribed accelerations. 


3. STATE SPACE MODEL 

The following state space model [l] for propagation of forces, velocities and accelera- 
tions makes it easy to express the recursive dynamics algorithms. 

The term spatial force refers to a 6 x 1 vector X{t) whose first three components are 
pure moments and whose last three components are pure translational forces. Similarly, 
the term spatial velocity V{i) describes a 6 x 1 vector of angular and linear velocities.’ 
The spatial accelerations A(i) are obtained by appropriate [l] time differentiation of the 
spatial velocities V{i). If the argument k is used, the corresponding force X(k), velocity 
V{k), and acceleration A (k) are defined at a typical joint k. If the argument i is used, the 
corresponding force X k (i ) velocity V k (j) and acceleration A*(t) are defined at node i of the 
body k finite-element model. 

The vector X + [k) is used to represent the spatial force on the “positive” side of joint 
k. The + superscript indicates that the corresponding variable is evaluated at a point on 
body k + 1 immediately adjacent and on the “positive” side, toward the base, of joint k. 
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The notation X~(k) is used to represent the force on the “negative”, toward the tip, side 
of hinge k. Similarly, the notation V + {k ) and V~(k) is used respectively for the spatial 
velocity on the positive and negative sides of joint k. 

To propagate forces, velocities and accelerations between the two typical spatial loca- 
tions i and k in the multibody system, define the “transition” matrix [l] 

*(M = (o £( p°) ( 31) 

in which L(k,i ) is the vector from point k to point t; and L(k,i) is the 3 x 3 matrix 
equivalent to L(k,i) x (•). This matrix has the following semi-group properties typically 
associated with a transition matrix for a discrete linear state space system. 

<f>(k,m) = <f>{k,i)<t>(i,m)] <f>(k,k)=U (3.2) 

and <j>~ 1 (k,m) = <f>(m,k). This matrix is used in the next section to develop spatial 
recursions for the kinematics and dynamics of the flexible multibody problem. 

4. FLEXIBLE MULTIBODY KINEMATICS 

4.1 Kinematics Internal to a Typical Flexible Body 

The velocity V + (k ) on the positive side of the joint k and the velocity V k (i) at nodal 
point i in body k are related by 

V k {i) = <t> T {k,i)V+{k) + Vfc(t) for all i <E fl(fc) (4.1) 

in which 

v 'jt(t') = <f> T (k,i)H T (k)6(k) + u k (i) i = l,---,N k -i 

v k {i) = (t> T {k,i)H T {k)6{k) i = N k (4.2) 

In Eqs. 4.1 and 4.2, u*(i) denotes the relative spatial velocity of the mass element at node 
i. The set fl(fc) is the set of all nodes in the finite-element model for body k. Note that 
the last nodal point N k in body k is assumed to be rigidly attached to the negative side 
of joint k. Hence, this point does not undergo an elastic displacement with respect to the 
joint k. This is reflected in Eq. (4.2). 

4.2 Recursive Kinematics for Flexible Multibody System 
The sequence of velocities V r + (A:) satisfies 

LOOP k = N - 1, - , 1 

V + {k) =<f> T {k + l,k)V + {k+l) + C T {k+l,k)v k+l {l) (4.3) 


END LOOP; 

with the terminal condition F+(JV+l) = 0. By definition, t>jfc + i(l) is the first 6-dimensional 
component of the relative velocity vector i. e., v k = [u*(l)> • • • > u /c(^)]> Note also 
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thatvjy+i — 0 . The 6x6N matrix C T {k+l, k) is defined as c T (*+i,*) = [*r(i,*),...,o|. 
Outward integration of this iterative equation leads to 


N-i 


v+ (*)=E'f r y.*K ?r tf+ 

J=* 


4.3 Recursive Kinematics Using Spatial Operators 

To express the kinematic relationships in Eqs. (4.1)-(4.3) in terms of an equivalent 
spatial operator [4] notation, define first the spatial operators 4 >, h, C, B, and H as 


I 0 

<£( 2 , 1 ) I 

W(AM) 4>(N, 2) 


0 \ 

0 

0 

I) 


h = [7,0] 


o 0 0 0\ 

C(2,l) 0 ••• 0 0 

• ’• o o 

VO 0 ••• C{N,N- 1 ) 0 J 


B = diag[B{l),"',B{N)\ H = diag[H {\), . . ■ , H(N)] 
in which the spatial operators -S(Ar) are defined as 


B{k) = mk,l),4>{k,2),---,<f>(k,N k )} 

Based on this notation, the kinematic relationships in Eqs (4.1)-(4.3) can be expressed as 


V = B*V+ + v 


(4.4) 


V = B*H*e + h*ir, v = X*X 
V + = $*C*v 

with V = [K x ,- - • ,Vat], v = [wi.-.-.wjy], X* = [h*,B*H*], X = [«,*], 
and 9 = \9 X , • • • , On}. Combination of (4.4) and ( 4 . 6 ) leads to 


(4.5) 

(4.6) 

u — [«!,•••, Ujvrj 


V = {I + B*$*C*)v ( 4 . 7 ) 

While the kinematic relationships in (4.4)-(4.7) apply to spatial velocities, similar relation- 
ships can be derived for the corresponding accelerations by appropriate [l] time differen- 
tiation. 
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5. INVERSE DYNAMICS 

RESULT 5.1. The total kinetic energy in the multibody system can be computed in term 
of the composite velocity vector X = [u, 0\ as 

K.E. = (l/2)i*Xi 

in which the system mass matrix X is 

X = 1/(7 + C$B)m(I + B*$*C*)H* (5.1) 

Eqs. (4.4)-(4.7) and (5.1) lead to a recursive inverse dynamics solution consisting 
of an outward sweep in which a sequence of system accelerations are computed. These 
accelerations are then multiplied by the appropriate blocks m k of the mass matrix m in 
(5.1). Then, an inward recursion is performed to compute the required applied moments. 
Because of the factorization M = M(I + C$B)m(I + B*$*C*)'H* of the mass matrix X, 
these two recursions are equivalent to multiplication of the system accelerations X by the 
composite mass matrix X. 

6. MULTIRIGID SYSTEM: A SPECIAL CASE 

If the flexible bodies in the system are rigidized, by setting the nodal point velocities 
to zero, then the flexible body mass matrix of Sec. (5) becomes the multirigid body mass 
matrix analyzed by the author in [1-4]. 

Multirigid Body Mass Matrix. The multirigid body mass matrix 

X = (6.1) 

in which 

M — BmB* — diag[M( 1), • - • ,M(N)} (6.2) 

can be obtained from the flexible body mass matrix by setting the elastic state-to-output 
operator h to zero. The diagonal block M{k) in Eq. (6.2) is the rigid spatial mass matrix 
of the rigidized body k about joint k. 

Recursive Evaluation of the Multirigid Body Mass Matrix 

The elements m R (k,j) of the mass matrix in (6.1) can be computed by 

72(0) = 0 


LOOP k = 1,',N 

R(k) = k - 1 )R{k - 1)4? [k, k - 1) + M{k) 

m R (k,k) = H(k)R(k)H T (k) 
x{k) = r(k)H T (k) 
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Loop i = k + 1,-. • , N 

x(i) = 4>{i,i - l)x(t - 1) 
m R {i,k ) = H(i)x{i ) 

End i Loop; 

END k LOOP; 


7. FLEXIBLE SYSTEM MASS MATRIX 

The goal of this section is to arrive at a spatially recursive algorithm that computes 
the flexible multibody system mass matrix by means of an inward recursion from the tip 
to the base. The approach used to do this is to first establish the identity in (7.1) below. 

Result 7.1. The matrix {I +C$B)m{I + B* $*C*) in the flexible multibody system mass 
matrix .M can be expressed as 

(/ + C$B)m{I + B*$*C*) = r + C$Br + rB*$*C* (7.1) 

in which r = m + CRC*. Furthermore, the diagonal matrix r = dmg[r(l), • • • , r(N)\ is a 
block-diagonal matrix whose diagonal blocks r (A - ) are given by 

r{k) = m(k) + C(k, k - 1 )R{k - l)C T (Ar, Ar — 1) (7.2) 

Inward Recursion for the Flexible Mass Matrix 

R{ 0) = 0 


LOOP k = l,--.,iV; 


r(A) = m(k ) + C(k, k - 1)R(A: - l)C' T (it, k - 1) 

M{k,k) = M{k)r{k)U T {k) 
x(k) = r(A)l/ r (A:) 

Loop * = k + 1, - - - , N; 

x(i) = <f>{i, i - l)x(* - 1) 

M{i,k) = H{i)x(i) 

End i Loop; 

END k LOOP; 

Spatial Operator Notation 

In spatial operator notation, the above recursions for the diagonal blocks of the mass 
matrix become 


r = CRC*+m ; R = BrB *; r = CBrB*C* + m 
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The above results are an extension to flexible multibody systems of the results obtained 
earlier by the author [1-4] for multirigid body systems. 


8. INNOVATIONS FACTORIZATION 
OF THE MASS MATRIX AND ITS INVERSE 

The flexible multibody system mass matrix At can be factored as 

M = (I + K)D(I+K*) 

in which the causal operator K and the diagonal operator V are 


( 8 . 1 ) 


(hCSBg hC$G V D= ( d °\ 
K H$Bg H<f>G ) ’ V° D ) 


(8.2a) 

(8.26) 


The Kalman gain operators g and G are defined in terms of the following Riccati-like 
equations 

p= C(P -GDG*)C* +m 

P = B(p - gdg*)B* 

G=PH*D ~ 1 ; g = ph*d~ 1 

D = HPH *; d = hph* 

Inverse of the Causal Factor ( I + K) 

(I + K )- 1 = I-t 


(8.3) 


in which C is the causal operator 

(hC^Bg hC$G\ 

L ~\ HVBg HipG ) 

Some of the spatial operators used in this result are defined as 

B{k) = B(k)[I - g(k)h(k)}; B = diag[B(l ),- • • ,B(N)} 


C(k, k — 1) = C(k,k — 1)[I - G(k - l)H(k - 1)] 


/ o o ••• o 0\ 

( C(2,l) 0 0 0 


Vo 0 • ■ • C(N,N- 1) o J 


rp(k, i) = B(k)C(k,k - 1) ■ ■ ■ B(i + l)C(i + l,i) 
xp = V>(M) ; * = ^xp(k,i){I - G(i)H(i) ] 

t=i * =1 

This states that the causal factor I + K is causally invertible. Furthermore it states 
that the inverse I — C can be computed by means of a spatially recursive Kalman filter. 
This Kalman filter will be described in more detail in the following section. Here, the 
immediate objective is to obtain the following factorization for the inverse M of the 
flexible multibody system mass matrix >1. bigskip 
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Innovations Factorization of the Mass Matrix Inverse. 


•M" 1 = [I - Z*)V~ l [I - C) 


(8.4) 


This result states that the inverse of the mass matrix is the product of an anticausal 
factor, a diagonal operator, and a causal factor. Recall that the equations of motion for 
the flexible multibody system, disregarding without loss of generality the effects of velocity 
dependent coriolis and gyroscopic terms, are: 

MX =7; X - M~ 1 7 (8.5) 

in which 7 = [ f,F ] is a composite vector made up of the elastic forces / and the applied 
joint moments F. 

Use of (8.4) in (8.5) leads to 

x = [i -e)v~ l [1-11)7 

This equation states that the known forces 7 must be operated upon by a two-stage filtering 
and smoothing process in order to obtain the system accelerations X. The first operation 
involves the causal factor (/— £,) which can be mechanized by a spatially recursive Kalman 
filter. The result of the first stage is an innovations process defined as [I — Z)7 and a 
residual acceleration process defined as P _1 (J— Z)7. This residual process is operated 
upon by an outward smoothing computation represented by the anticausal factor (/-£*) to 
obtain the system accelerations X. These filtering and smoothing operations are described 
more completely in the following section. 

9. RECURSIVE FORWARD DYNAMICS 
Riccati Equation for Articulated Inertias 


LOOP k = 


P + ( 0) =0 

(9.1) 

p k = m k + C k , k -iP + [k - l)Cl k _ 1 

(9.2) 

II 

(9.3) 

9k =P k hld k l 

(9.4) 

Pk = {I ~ 9k h k )Pk 

(9.5) 

p ~( k ) = E E *(M pt(iJ)4> T (k,j) 

»en(fc) yen(jt) 

(9.6) 

D(k) = H(k)P~[k)H T (k) 

(9.7) 
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END LOOP; 


G{k) = p-{k)H T {k)D~ 1 [k) 
P+(k) = {I-G(k)H(k)}P~(k) 


(9.8) 

(9.9) 


This discrete-step Riccati-Iike equation computes a sequence of rigid Kalman gains 
Cr(fc) defined at every joint angle k and a corresponding sequence of flexible body Kalman 
gains < 7 * = < 7 *(*\i) defined for every pair of nodes i,j in body k. This inward recursion is 
performed simultaneously with a filtering algorithm described below. 

INWARD FILTERING: SPATIAL FORCES 


Z + { 0) = 0 (9-10) 

LOOP k = JV; 


z-{k) = C k , k -iZ + {k- 1) 

(9.11) 

e k = fk hk z k 

(9.12) 


(9.13) 

4 = 4 + 9k€ k 

(9.14) 

z-(k)= *(m>*(*) 

ten(fc) 

(9.15) 

E~{k) = F{k) - H{k)Z~(k) 

(9.16) 

E + {k)=E-{k)/D{ k) 

(9.17) 

Z + {k) = Z~{k) + G[k)E-{k) 

(9.18) 


END LOOP; 

The result of this filtering stage is a sequence of residuals E+ (A:) defined at every joint 
k and a sequence of flexible body residuals e£ (i) defined at every nodal element i of every 
flexible body k. 

OUTWARD SMOOTHING: SPATIAL ACCELERATIONS 

A + (iV) = 0 (9.19) 

LOOP k = N ,-- - , 1; „ , 

${k) = E + {k) - G r (A:)A + (fc) (9-20) 
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A~(k) = A + (k)+H T (k)0(k) (9.21) 

a k{N k ) = <f> T {k,N k ) (9.22) 

a t (0 = 4> T {k,i)a k {N k ) (9.23) 

N k - 1 

“*(0 = «*(*)“ 53 0*O'»O a fc(j) (9.24) 

y=i 

(0 = a k (0 + u k (*) (9.25) 

A + (k - 1) = C T (k,k - l)a k (9.26) 

END LOOP; 


The result of this smoothing stage is a sequence of joint angle accelerations 0(k) and 
flexible body accelerations u k (i). 

PHYSICAL INTERPRETATION 

The forward dynamics problem is solved by a spatially recursive Kalman filtering 
process which begins at the tip of the system and proceeds inwardly toward the base. This 
filtering algorithm computes: (1) a sequence of spatial forces z{k) at the flexible bodies 
and Z(k) at the joints; (2) a sequence of residuals e + (k) and E + [k)\ and (3) a sequence of 
Kalman gains g k at the flexible bodies and G(k) at the joints. The filtering stage uses as 
an input the elastic forces f(k) at body k and the applied joint moments F(k) at joint k. 
The residuals and the Kalman gains are stored for subsequent processing by an outward 
smoothing stage. 

The smoothing stage is an outwardly recursive process which begins at the base of 
the system and proceeds from body to body toward the tip. The smoother computes 
a sequence of spatial accelerations a k at the flexible bodies and A(k ) at the joints. The 
smoother also computes a sequence of relative elastic accelerations u k at the flexible bodies 
and joint angle accelerations 6{k ) at the joints. 

Riccati Equation 

One of the central features of the inward filtering algorithm is the spatial Riccati 
equation in Eqs. (9.l)-(9.9) which accumulates the outboard spatial inertia as the recursive 
computations are performed. 

This Riccati equation begins at the tip of the system with the initial condition P+ (0) = 

0 in Eq. (9.1). This initial condition means physically that there is no spatial inertia 
outboard of this fictitious joint. 

Eq. (9.2) is used to add to the body k free-free mass matrix m k the spatial inertia of 
a fictitious articulated rigid body which is equivalent to collection of bodies outboard of 
joint k — 1. This equivalent inertia is transferred from the joint k - 1 to the attachment 
nodal point 1 in body k by the transition operator C(k, k — 1). 

Eq. (9.3) computes the flexible body k articulated mass matrix. This matrix can be 
viewed as a reduced-order body k mass matrix. The order reduction occurs because the 
operator h(k) has the effect of constraining the last nodal point N k in the finite-element 
model of body k. 
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The Kalman gain g(k ) in Eq. (9.4) is a 6 Nx 6(N- 1) matrix which is used to compute 
the projection operator [I - g[k)h(k)\. This projection operator, when multiplied in (9.5) 
by the matrix p~ (A:) leads to the updated matrix p + ( k ) which has a null space of dimension 
N - 6 in the direction of the operator h(k). Eqs. (9.6) transfers the flexible articulated 
body inertia to an equivalent rigid body mass matrix at joint k. 

Eqs. (9.7)-(9.9) are identical to the computations involved in crossing joint k in the 
multirigid body forward dynamics algorithm in [1]. They involve the following computa- 
tions: (1) evaluation of the scalar articulated inertia D{k) about joint k. This inertia is 
the inertia about joint k of the composite body outboard of joint k, with all of the degrees 
of freedom outboard of joint k being unlocked; (2) computation of the Kalman gain G(k) 
in Eq. (9.8) to determine the projection operator [I — G(k)H(k)] in Eq. (9.9). When this 
operator pre- multiplies the rigid-body spatial inertia P~ [k ), the updated spatial articu- 
lated P + {k) results. The spatial inertia P + {k) is that of a fictitious body which has no 
inertia along the joint k axis. 

After crossing the joint k in Eq. (9.9), the algorithm lets k —* k + 1 and returns to 
Eq. (9.2). The process of crossing a flexible body and a joint has been completed. 

Filtering 

The filtering algorithm in Eqs. (9.10)-(9.18) is a spatially recursive Kalman filter 
based on an inward sequence which is performed together with the Riccati equation just 
described. The Kalman filter begins at the tip of the system, the fictitious point “0”, with 
the initial condition Z + ( 0) = 0 in Eq. (9.10), which indicates that there are no external 
applied forces at this point. This begins a recursive process which takes as inputs the 
sequence of elastic forces f(k) and the sequence of applied joint moments F{k). The out- 
puts of this process are a sequence of flexible-body residuals e + (fc) and joint axis residuals 
E+(k). 

Eqs. (9.1l)-(9.13) compute the flexible-body residual e + (A:) at body k. First, Eq. 
(9.11) determines the spatial force z~ (k) that exists in body k due to the previously 
determined force Z+ ( k — l) at joint k — 1 reflecting the presence of all of the bodies 
outboard of this joint. In Eq. (9.11), this force is multiplied by the operator h{k ) to obtain 
the predicted output force h(k)z~(k). The flexible body innovations e — (A:) in Eq. (9.12) 
can be viewed as an “error” quantity equal to the difference between the actual force f[k) 
due to the body stiffness and the predicted force h(k)z~(k ) due to the preceding bodies 
1, • • • , A: — 1 outboard of joint A: — 1. The residual acceleration process e + (A;) is computed 
from e~{k) by dividing by the articulated spatial mass matrix d(k) which emerges from the 
Riccati equation. This division is indicated in Eq. (9.13). The flexible body residual e + (A;) 
has a very interesting physical interpretation. It corresponds to the inertial acceleration 
that the finite-element nodes in body k would undergo, if the “future” degrees of freedom 
were locked. 

The computation in Eq. (9.14), which determines the updated spatial force distribu- 
tion z + (k) in body k, has the effect of unlocking the 6 degrees of freedom associated with 
the all of the nodal points in body k except the last one. 

Eq. (9.15) sums the spatial force estimates z + (k) at the nodal points in body k and 
transfers them to joint k. The result of this summation is the 6-dimensional spatial force 
Z~(k). This force reflects at joint k the effect of all of the preceding bodies. The next 
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steps, conducted in Eqs. (9.16)- (9.18), cross or unlock joint k. These steps are identical 
to that used in the multirigid body algorithms [l] and result in the updated spatial force 
Z + (k ) on the positive, inward toward the base, of joint k. 

At this juncture, the filtering algorithm lets k -*• k + 1 and returns to Eq. (9.11) to 
start the computations necessary to cross the next body. 

Smoothing 

The smoothing process in Eqs. (9.19)-(9.26) is an outward recursion which starts 
at the base of the system and proceeds outwardly to its tip. The smoothing process 
produces a sequence of rigid-body spatial accelerations A{k) at the joints and of flexible- 
body accelerations ot(Ar) at the nodal points of the flexible bodies. It also produces the 
relative accelerations ti(A;) at the flexible bodies and the joint-angle accelerations 0{k ) at 
the joints. The smoother uses as inputs the sequences of residual accelerations e~*~ (Ik) and 

E+(k). It also uses the Kalman gain sequences g(k) at the flexible bodies and G()k) at the 
joints. 

The outward smoothing sequence begins with the terminal condition A + (N) = 0, 
which corresponds to the assumption that the base of the system is immobile. Eqs. (9.20) 
and (9.21) can be viewed as specifying the computations necessary to cross joint k in the 
outward direction. 

Eq. (9.22) computes the spatial acceleration aj fc(AI^) of the attachment point jV^. 
Eq. (9.23) computes the spatial accelerations ajj'(i) at the internal finite-element nodes 
of the flexible body k. The -f- indicates that the corresponding acceleration is that of 
a rigid body frame attached to a rigidized flexible body obtained by setting the elastic 
displacements to zero. The elastic displacement accelerations at the finite-element nodes 
are computed by Eq. (9.24). Eq. (9.25) then computes the total inertial accelerations 
of the finite- element nodes in body k. The spatial acceleration of the first node, also 
referred as an attachment node, is then propagated by Eq. (9.26) to the positive side of 
joint A: — 1. At this stage, the algorithm lets k k — 1 and returns to Eq. (9.20) to begin 
the computations associated with the next body Ar — 1. 

Modal Expansions 

The above algorithm has been expressed in terms of nodal coordinates to model the 
flexibility of each of the flexible bodies in the system. In many cases, it is more conve- 
nient to use what are typically referred to as modal coordinates. A modal model for a 
flexible body is obtained by doing a modal or eigenfunction analysis of the finite-element 
model for the same body. Use of these expansions leads to a spatially recursive forward 
dynamics algorithm that is almost identical in form to that of (9.1)-(9.26) above, but in 
which the quantities (displacements, velocities, accelerations, forces, and mass) involved 
are interpreted in terms of modal coordinates as opposed to the nodal coordinates used in 
(9.l)-(9.26). 


10. CONCLUDING REMARKS 

The inverse and forward dynamics problems for flexible multibody systems have been 
solved using the techniques of spatially recursive Kalman filtering and smoothing. These 
algorithms are easily developed using a set of identities associated with mass matrix factor- 
ization and inversion. These identities are easily derived using the spatial operator algebra 
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developed by the author. Current work is aimed at computational experiments with the 
described algorithms and at modeling for control design of limber manipulator systems. It 
is also aimed at handling and manipulation of flexible objects. 
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